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1. INTRODUCTION 

Formation Control of multiple mobile robots has attracted a great deal of attention in recent years. 
This is due to the fact that formation guidance is one way of efficient transportation systems such as 
automobiles and airplanes, and that it can become a system that brings about more efficient work 
achievement than a single robot [1]-[4]. As control approaches to realize formation control, behavior-based 
methods [5]-[7], multi-agent systems [8]-[11], virtual structure methods [12], [13], leader-follower methods 
[14]-[18], etc. are generally known. This paper is a study on the formation control of multiple mobile robots 
using the leader-follower method. In the leader-follower method, multiple mobile robots are classified into a 
leader and followers. The control purpose of the leader is to make configuration and route selection of the 
formation, while the control purpose of the followers is to control so that the relative positional relationship 
with the leader is kept at a specified reference. Therefore, it can be said that the subject examined in the 
leader-follower method is to design control systems on the followers. 

The authors have been studying various subjects in the formation control by the leader-follower 
method using mobile robots with multiple sonar sensors which are described as follows [19]-[24]. Generally, 
since the formation control law based on the dynamic inversion [25] included the states of both leader and 
follower [14]-[16], the follower needed means for obtaining the state of the leader to implement the control 
law on real mobile robots. As one way to avoid this, we proposed self-made input (SMI), which was an 
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autonomous decentralized control law utilizing an estimate of the state of the leader [19], [20]. The SMI did 
not need any communication means between the mobile robots and improved the applicability of the leader- 
follower method. We also studied formation control in obstacle scattered environments [21]-[24]. In these 
studies, multiple sonars were adaptively used for two purposes: leader tracking for formation control and 
obstacle detection to avoid collision with obstacles. The formation control was then realized while avoiding 
obstacles even in the presence of obstacles [21], [22]. Furthermore, we developed a formation control method 
for large obstacle avoidance in which modules reinforced for the avoidance were introduced [23], [24]. 

One of the new problems with the formation control of mobile robots is to develop a function that 
can change the formation shape as necessary. In this paper, we call this function “shape transition”. In the 
formation control with large obstacle avoidance described above, an algorithm was proposed in which the 
local part of the shape was temporarily changed to a shape that easily avoided obstacles and then returned to 
the original shape [23], [24]. It may also be desirable from the practical point of view to change the formation 
shape to reconstruct a formation by adding or removing mobile robots forming the formation. It can be said 
that the shape transition is a function that improves the flexibility of the formation control of the mobile 
robots. For these reasons, this paper investigates the shape transition method of multiple mobile robots during 
formation control by the leader-follower method. First, we propose basic shape transition methods under 
formation control for the case of two mobile robots. These methods are extended to the shape transition of 
three mobile robots. The effectiveness of the proposed technique is verified by experiments using a real 
mobile robot Pioneer with multiple sonar sensors. 


2. FORMATION CONTROL OF MOBILE ROBOT WITH SONAR SENSOR 
2.1. Leader-follower method 

Consider a mobile robot with the non-holonomic constraint. The position of the robot moving in the 
two-dimensional plane is represented by a stationary Cartesian coordinate system (x(t), y(t)), where t is 
continuous time. The direction angle of the robot is O(t) (-z < O(t) < m [rad]), which is measured from the 
positive x-axis. The linear and angular velocities are v(t) and w(t), respectively, which are the control inputs 
of the mobile robot. The equation of kinematics for the mobile robot is given by (1). 


x = v(t)cos@0 (t) 
ý = v(t) sind (t) (1) 
Ô = w(t) 


Where the magnitude of the control input is constrained by (2). 
IV()| S Vmax max (2) 


Vmax and @max are the maximums of v(t) and w(t), respectively. Figure 1 shows how two mobile 
robots are controlled by the leader-follower method, where L and F are the leader and follower robots, 
respectively. Hereafter, subscripts ‘/’ and ‘f attached to variables refer to the leader and the follower, 
respectively. Both are governed by the kinematical equations that rewrite the variables in (1) into their 
variables, respectively. The relative distance between the leader and follower is denoted as d; (=ds) and the 
relative angles from their headings are denoted as y; and ys, respectively. The purpose of the formation control 
by the leader-follower method is to navigate multiple mobile robots from start to goal while forming a 
formation shape. The follower is then controlled to keep d; and yy at their references dff and y/*, respectively. 
Fujimori et al. proposed SMI, which was an autonomous decentralized control law utilizing the estimated 
state of the leader [19], [20]. The SMI did not require any communication means between the leader and 
follower. We also use the SMI for the formation control law in this paper. 


2.2. Mobile robot pioneer 

Figure 2 shows photographs of mobile robots Pioneer-1 and Pioneer-3 used in formation control in 
this paper [26]-[28]. Pioneer-1 shown in the photographs on the left and middle are 450 [mm] in length, 360 
[mm] in width for the left and right wheels, and 225 [mm] in height. Pioneer-3 shown in the photograph on 
the right is slightly larger than Pioneer-1. The drive system of Pioneer-1 and Pioneer-3 is provided by two 
independent, reversely rotatable DC motors on the left and right wheels. Pioneer-1 has seven ultrasonic 
sonars, while Pioneer-3 has eight ultrasonic sonars. Table 1 shows the attached angle of the sonars on 
Pioneer-1 and Pioneer-3. 
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Figure 1. The relative position between the leader and follower robots 











Figure 2. Pioneer-1 and -3 


Table 1. Attached are angles of sonars in Pioneer-1 and -3 


gi [deg] 
peo Pioneer-1 Pineer-3 
0 90 90 
1 30 50 
2 15 30 
3 0 10 
4 -15 -10 
5 -30 -30 
6 -90 -50 
7 - -90 


In the formation control with obstacle avoidance [22]-[24], the multiple sonars were used not only to 
detect obstacles for collision avoidance but also to obtain the relative distance and angle with the leader robot 
for formation control. This function was called “adaptive sonar assignment” [22]-[24]. Since this paper does 
not consider obstacle avoidance, the sonars are used for only obtaining the relative distance and angle. 
Assuming that s; is the output value of the i-th sonar and @; is the attached angle of the i-th sonar, the relative 
distance dy and angle yp are obtained by averaging the weighted output of the fired sonars. That is (3) and (4). 


Sows 
d = ley YY LOL 3 
f LiegzWi ( ) 
ZicezWi®i 
S 4 
Yr vicFWi ( ) 


Where w; is the weighting coefficient and F means the set of sonar numbers for leader track. See [22] for 
details. 

In the previous studies dealing with obstacle avoidance [22]-[24], the follower estimated the 
position of the leader during formation control, called “leader estimate”, and used to set the target position 
for reconstructing the formation after avoiding the obstacle and to re-detect the leader. “Leader estimate” will 
be included in the proposed control algorithm because the same procedure will be needed in the shape 
transition described in the next section. 
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3. FORMATION SHAPE TRANSITION IN LEADER-FOLLOWER METHOD 

In this section, we first propose basic shape transition methods for the case of two mobile robots 
under formation control by the leader-follower method. The extension to the case of three mobile robots is 
next shown. As mentioned in Section 2.2, the sonars attached to the mobile robot are located forward, 
including the left and right sides, and have the non-holonomic constraint in the kinematics, so that there is a 
constraint on the formation shape feasible by the leader-follower method. In the case of two mobile robots, 
the follower must be positioned behind the leader. Therefore, there are three shapes of the follower relative to 
the leader: line, right-back, left-back. In the case of three mobile robots, three types of line, zigzag, triangle 
shapes are considered. When the number of mobile robots increases further, there may be a variety of shapes 
as a whole, but locally it is possible to regard a combination of the shapes in the cases of two or three mobile 
robots. Therefore, the formation shape transition considered in this paper can be applied to the transition in 
general shape. In the formation control considered in this paper, it is supposed that the leader is moving at a 
constant speed in a certain direction. 


3.1. Shape transition in two mobile robots 

This paper proposes two shape transition methods described below according to transition 
movement, which refers to the amount of shape transition and is quantitatively defined as the integral value 
of the control input. It is also defined as the time required to achieve the shape transition. However, their 
exact definitions are not necessarily useful, so we will discuss the shape transition only from a qualitative 
point of view. First, we propose two shape transition methods and then mention their application conditions. 


3.1.1. Shape transition for small transition movement (M-1) 

Figure 3 shows the shape transition from line to right-back as an example that the transition 
movement is small. L and F represent the leader and follower, respectively, and illustrate the transition 
behavior for each step. The black block arrow means the shift to the next step. At the beginning of the shape 
transition shown in Step-1, F changes the referenced relative distance and angle for the line to the distance 
and angle for the right-back. It is denoted as “New d/“, yf” in Figure 3. As the result, the transition to fight 
back is achieved by shifting to the right while continuing the formation control. This behavior is denoted as 
“on FC”. 


-e o n —eo— 
_ 


1: New df y” 2: on FC 


Figure 3. Shape transition from line to right-back by M-1 


3.1.2. Shape transition for large transition movement (M-2) 

Figure 4 shows the shape transition from right-back to left-back when the transition movement is 
large. In this case, the shape transition is surely performed by interrupting the formation control. The position 
where the follower should move is first defined. This is called target position (TP). The direction angle of F 
and the estimated position of L obtained by “leader estimate” [22]-[24] are used for defining the TP. The 
transition to the TP is then performed. The specific process is shown below in the discrete-time 
representation with constant sampling time, denoted as Ts; that is, tg represents the k-th sampled discrete-time. 


C >€P) >(TP) 
— © re 
D ® 


1: Set TP 2: Wait, TP Update 3: Approach to TP 





Figure 4. Shape transition from right-back to left-back by M-2 
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Step-1: Suppose the starting time of the shape transition is tz=tkı. Letting the referenced relative distance and 
angle for left-back be d/* and yf, and the estimated position of L be (£, (t), 9, (t,,) ), the TP is 


given by (5). 


H (tei) = 2 (t1) — a cos( O¢(te1) + vp) (5) 


Vp (ter) = Pı ltr) — dp” sin( Of (tyr) +y”) 


It is denoted as “set TP” in Figure 4. 
Step-2: The movement of F pauses for a specified while. It is denoted as “Wait”. For tk > tii, the TP is 
updated by (6). 


i (tk) = Xp (tk-1) + VoT; cos Or (tk1) (6) 
Yp (tk) = Yp (tk-1) + VoT; sin Or (tk1) 
It is denoted as “TP update” in Figure 4. 
Step-3: Suppose that “Wait” is finished at tk=tx2 (>t). After that (tk > tf), F moves to the TP according to the 
following control law, 


V p(t.) = Vmax (7) 
O; (t, ) = k; (0, (t, ) —6, (t, )) (8) 


A -1 Y t) — Yst) 
GUJE E E 9 
p(t) = tan x, (4) —*; (6) (9) 


where kr is a positive constant gain. This behavior is denoted as “Approach to TP”. 
Step-4: After arriving at the TP, F returns to formation control by re-detecting L. 


3.1.3. Selection of shape transition method 

M-1 only changes the referenced relative distance and angle for the new shape and performs the 
shape transition while continuing the formation control, denoted as “on FC” in Figure 3. For applying M-1, it 
is necessary to satisfy the following conditions that 1) the leader to follow is within the range of sonars 
detectable relative to the follower and 11) the referenced relative distance and angle of the new shape are 
within the fluctuation range which can correspond with the control law of the leader-follower method; that is, 
within the range which does not cause input saturation. Otherwise, M-2 is selected for shape transition. The 
reason why “Wait” is included in step-2 of M-2 is that it is difficult for a mobile robot with the non- 
holonomic constraint to move smoothly immediately after “Set TP”. It is, therefore, a means to wait until the 
TP becomes a position that is easy to move. Also, “TP Update” given by (6) assumes that the leader is 
moving at a constant velocity vo without changing its direction. 

Figure 5 shows the flow chart of the follower control algorithm for formation control and shape 
transition summarized above. Triggering shape change branches to the formation control or the shape 
transition at “Shape Change”. The former is called N-mode, while the latter is called T-mode. N-mode 
contains modules for the formation control described in Section 2, which sequentially executes “adaptive 
sonar assignment’, “leader estimate”, “SMP” and generates the control inputs v(t) and wt) to the follower. 
In T-mode, on the other hand, the shape transition method is selected by “transition method (TM) select”. For 
M-2, v(t) and w(t) are generated from the process described in the previous section. The estimated position 
of the leader, which has been obtained at “leader estimate” in N-mode, is utilized at “Set TP” in M-2. There 
are two cases to select M-2 for the shape transition on two mobile robots: right-back — left-back or left-back 
— right back. Otherwise, M-1 is selected. 
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Trigger of shape change 









[N-mode] [T-mode] 


No Yes 


Adaptive Sonar 
Assignment 


Leader Estimate 


Vf, COf 


Follower Robot 


Figure 5. Follower control algorithm for formation control and shape transition 


3.2. Application to three mobile robots 

The proposed shape transition methods are applied to the cases of three mobile robots. In these 
cases, there are two follower robots which are referred to as F; and F2 hereafter. It is assumed in this paper 
that the shape transition of Fı is superior to that of F2. The priority of the shape transition is not changed 
under formation control. 


3.2.1. Line — triangle 

Figure 6 shows the shape transition from line to the triangle. Since the transition movement of F 1s 
small, M-1 is applied to F1. The referenced relative distance and angle for the line are changed to the distance 
and angle for the triangle in step-1. On the other hand, since the transition movement of Fz is large, M-2 is 
basically applied to F2. Therefore, F2 first sets TP for triangle allocation. If Fz starts the transition behavior 
immediately, it is risky to collide with F1. To avoid this, “wait” is inserted in step-2 and the position of the 
TP is updated during that time. F2 moves to the TP when there is almost no risk of contacting Fi. 


® 
ee e > e —+@ > @~ _—@ 
--->® --->® 


1: A: New d” y? 2: Fi: on FC 3: Fi: on FC 
F>: Set TP F>: Wait, TP Update F>: Approach to TP 


Figure 6. Shape transition from line to a triangle 


3.2.2. Triangle — line 

Figure 7 shows the shape transition from triangle to the line. M-1 is applied to both Fı and F2 
because the transition movement is small. However, since F2 needs to consider the non-holonomic constraint 
and risk-avoidance of collision with F1, “wait” is inserted in Step-1. After “wait” is finished, the referenced 
relative distance and angle for the triangle are changed to the distance and angle for line, denoted as “New 
dff, yf” in step-2. 


3.2.3. Line — zigzag 


Figure 8 shows the shape transition from line to zigzag. Since the transition movement of F is 
small, M-1 is applied to Fı. On the other hand, since the transition movement of Fz is also small, the 
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application of M-1 to Fz is reasonable. However, the position of F2 in zigzag after the transition is almost the 
same as that in line. Therefore, it is possible to reduce waste of movement by continuing the previous action 
for a while. This continuous action is called “self”. The referenced relative distance and angle for the line are 
changed to the distance and angle for zigzag. 


3.2.4. Zigzag — line 

Figure 9 shows the shape transition from zigzag to the line. M-1 is applied to both F and F2 because 
the transition movement is small. Similar to the transition from line to zigzag shown in Figure 8, “Self” for 
F2 is introduced to reduce unnecessary transition movement. 


a 
— eo eoo 


o” 


1: Fi: New d” y7 2: Fi: on FC 
Fa: Wait F: New d® y? 


Figure 7. Shape transition from triangle to line 
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-e0 0—0 





1: Ai: New d” y? 2: Fi: on FC 
F>: Self Fo: New d” y? 


Figure 8. Shape transition from line to zigzag 


my, 


eo © > @-—e—-@ 





1: Ai: New d” yT 2: Fi: on FC 
F>: Self Fo: New d% y? 


Figure 9. Shape transition from zigzag to line 


3.2.5. Triangle — zigzag 

Figure 10 shows the shape transition from triangle to zigzag. Performing the transition from triangle 
to zigzag directly, a collision may have occurred because the transition behavior of F and F> is interrupted 
each other. The risk of colliding between the followers is then avoided by passing through-line on the way. 
The transition behavior shown in Figure 10 is therefore constructed by combining with that in Figure 7 and 
Figure 8. 


3.2.6. Zigzag — triangle 

Figure 11 shows the shape transition from zigzag to the triangle. Similar to the transition from 
triangle to zigzag, the risk of colliding between the followers is avoided by passing through-line on the way. 
The transition behavior shown in Figure 11 is therefore constructed by combining with that in Figure 6 and 
Figure 9. 
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1: A: New d” yo 2: Fi: on FC 3: H: New d” ye 
F>: Wait F: New d” y7 F>: Self 
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4: Fi: on FC 
Fo: New d?” y” 


Figure 10. Shape transition from triangle to zigzag 
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1: Fi: New d” yT 2: Fi: on FC 3: Ai: New d” y? 
F>: Self F: New d” yT F>: Set TP 
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4: Fi: on FC 5: Fi: on FC 
F: Wait, TP Update F>: Approach to TP 


Figure 11. Shape transition from zigzag to triangle 


4. SHAPE TRANSITION EXPERIMENT 

To demonstrate the proposed shape transition methods, this section presents experimental results 
using three mobile robots, two pioneer-1 and one pioneer-3 which are shown in Figure 2. The blue pioneer-1 
was used as a leader robot, denoted as L, the black Pioneer-1 as the first follower robot, denoted as F, and 
the red pioneer-3 as the second follower robot denoted as F2. The referenced relative distance and angle for 
the formation shape; line, zigzag, and triangle, were given as follows. 


* Line (Shape no.=71) 


dp’ = 600 [mm] ya’? = 0 [deg] ... (Fi) 

dp’ = 600 [mm] yp! = 0 [deg] ... (F2) 
* Zigzag (Shape no.=72) 

dp’ = 600 [mm] ya’? = -20 [deg] ... (Fi) 

dp’ = 600 [mm] yp’? = 20 [deg] ... (F2) 
* Triangle (Shape no.=73) 

dp’ = 600 [mm] ya’? = 15 [deg] ... (Fi) 

dp’ = 600 [mm] yp! = -30 [deg] ... (F2) 
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There are various reasons for the purpose of carrying out the shape transition such as obstacle 
avoidance, transportation efficiency, and addition or reduction of robots. Furthermore, it may be possible to 
consider the command generation of the shape transition from the leader or followers. Since this paper 
focuses on demonstrating the effectiveness of the proposed shape transition methods, in the experiments 
shown below, the triggering of the shape change is given by a simple method; that is, the travel distance 
(position) of the follower. In Section 3, the shape transition methods for the cases of two and three mobile 
robots were described. Since M-1 and M-2 proposed on the two mobile robots are embedded in the transition 
behavior of Fı and Fz for the cases of three mobile robots, the following in this section shows the 
experimental results of three mobile robots. 


4.1. Experiment 1: line — triangle 

Figures 12-17 show the experimental results of a shape transition from line to the triangle. The solid 
lines in Figure 12 represent the loci of movement of three mobile robots, respectively. The light-blue and 
magenta dashed lines indicate the estimated location of L by Fı and F2. The marks; triangle, diamond, etc. 
indicate the positions to be noticed in the transition. The state at those times corresponds to the marks in 
Figures 13-17. The starting position of L was the origin in the (x, y) coordinate system, and the goal position 
was (x, y)=(5000, -1500) [mm]. The upper figure in Figure 13 shows the time history of the mode flag 
selected by Fı and F2, which is listed in Table 2. The lower figure shows the time history of formation shape; 
that is, shape no. 


Table 2. Mode flag 


Mode flag Mode 
19 “Self” in T-mode 
20 N-mode 
21=28 A-mode ” 
29 “Wait” in T-mode 
30 “Approach to TP” in T-mode 


*) A-mode is not used in this paper. 


Trajectory: e-flg=16 



































| 
-2000 -1000 0 1000 2000 3000 4000 5000 
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Figure 12. Traces of L, Fi, and F>, and traces of leader position estimated by F) and F», line — triangle 
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Figure 13. Time histories of mode flag and shape number, line — triangle 
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Follower-1 : Sonars for tracking Leader 
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Figure 14. Time histories of sonar number for tracking leader, F1, line — triangle 
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Figure 15. Time histories of sonar number for tracking leader, F2, line — triangle 
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Figure 16. Time histories of relative distance d; line — triangle 


IAES Int J Rob & Autom, Vol. 10, No. 4, December 2021: 275 — 288 


Int J Rob & Autom ISSN: 2722-2586 g 285 


Relative angle 
30 ee E E E E 













































































p E E "E 
Y 
20 ‘ fl 
| | Yez 
i \ | 
lon a | I i 
j II) 
oH af l — 
| | | 
real TJ 
© \_ al | | 
= 20 . — 
\ gj 
-30 y | 
-40 
-50 
-60 IE E E E | ji E E E <a 
0 10 20 30 40 50 60 70 80 


t [s] 


Figure 17. Time histories of relative angle ys line — triangle 


As shown in Figure 12, the three mobile robots started with forming Line. Then, as shown in 
Figure 13, F2 changed the shape from line to triangle at t=23 [s] (shape no.= 71 — 73). Then, the TP was set 
at the position marked by the green triangle, and “wait” (mode flag = 29) was set. Mode flag was changed to 
30 at 29 [s]; that is, “approach to TP” started. The position of the TP was updated as shown by the green 
solid line in Figure 12. F2 returned to N-mode at t=40 [s] (red diamond) and reached the goal in the form of a 
triangle. On the other hand, F; had always completed the shape transition in N-mode. Figure 14 and 
Figure 15 are the time histories of the lower limit (Ssn1) and upper limit (Ssn2) of the sonar number used to 
detect the leader. Also, when Fired (green dashed line) is between Ssn1 and Ssn2, it means that the leader is 
being detected by the sonars. Although F2 was temporarily unable to detect L (Fired =-1) during formation 
control, the formation control was stably performed because it took only a small amount of time. Figure 16 
and Figure 17 show the time histories of the relative distance and angle. The relative distance dj and angle yr 
of Fı almost showed the same as their references. On the other hand, the relative distance dp and angle yf2 of 
F showed close to their references except during “wait” and “approach to TP”. 


4.2. Experiment 2: line — zigzag 

Figure 18 and Figure 19 show the experimental results of a shape transition from line to zigzag. The 
start and goal positions of L were the same as those in experiment 1. F2 changed the shape from line to zigzag 
at t=23 [s] (shape no.=71—>72), selected “self” (mode flag=19) for 1 [s], then returned to N-mode (red 
diamond), and reached the goal in the form of zigzag. F1, on the other hand, completed the formation control 
with N-mode at all times. 
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Figure 18. Traces of L, Fi, and F2, and traces of leader position estimated by F and F2, line > zigzag 
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Figure 19. Time histories of mode flag and shape number, Line — Zigzag 


4.3. Experiment 3: zigzag — triangle 

Figure 20 and Figure 21 show the experimental results of a shape transition from zigzag to the 
triangle. The start and goal positions of L were the same as those in experiment 1. F2 changed the shape from 
zigzag to line with t=23 [s] (shape no.=72—71) and returned to N-mode with “self? (mode flag=19) selected 
for 1 [s] (red diamond). F2 furthermore changed the shape from line to triangle at t=42 [s] (shape 
no.=7 1—73) and then reached the goal by taking the same transitional behavior as in experiment 1. F1, on the 
other hand, completed the formation control with N-mode at all times. 
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Figure 20. Traces of L, Fı, and F2, and traces of leader position estimated by F) and F2, zigzag — triangle 
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Figure 21. Time histories of mode flag and shape number, zigzag — triangle 
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5. CONCLUSION 

This paper has presented a formation shape transition technique of multiple mobile robots in the 
leader-follower method as a new function that gives flexibility to the formation control of mobile robots. 
First, we proposed basic shape transition methods for the case of two mobile robots under formation control 
by the leader-follower method and then extended the methods to the shape transition of three mobile robots. 
The effectiveness of the proposed technique was demonstrated by experiments using real mobile robots 
which were equipped with multiple sonar sensors. 

Although the number of robots treated in this paper was two and three, the methods proposed in this 
paper applied to the shape transition in the number of more. In addition, in the shape transition with three 
mobile robots, the priority in the follower robots for performing transition movement was not changed. If it is 
possible to change the priority, a more efficient shape transition seems to be possible. This also leads to a 
more flexible shape transition with the change of the leader robot. These are future research subjects. 
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